﻿using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Windows;
using System.Windows.Controls;
using System.Windows.Data;
using System.Windows.Documents;
using System.Windows.Input;
using System.Windows.Media;
using System.Windows.Media.Imaging;
using System.Windows.Shapes;
using Microsoft.Kinect;

using System.IO;

namespace KinectStudio.ModuliTracciamento
{
    /// <summary>
    /// Interaction logic for Scheletro.xaml
    /// </summary>
    public partial class Scheletro : Window
    {
        private KinectSensor sensore;

        public Scheletro()
        {
            InitializeComponent();
            
            
        }

        private void Window_Loaded(object sender, RoutedEventArgs e)
        {
            foreach (KinectSensor possibileSensore in KinectSensor.KinectSensors)
            {
                if (possibileSensore.Status == KinectStatus.Connected)
                {
                    this.sensore = possibileSensore;
                    break;
                }
            }
            if (this.sensore != null)
            {
                this.sensore.SkeletonStream.Enable();
                this.sensore.SkeletonFrameReady += this.RilevamentoScheletroPronto;
                try
                {
                    this.sensore.Start();
                }
                catch (IOException)
                {
                    this.sensore = null;
                }
            }
        }

        private void Window_Closing(object sender, System.ComponentModel.CancelEventArgs e)
        {
            if (this.sensore != null)
            {
                this.sensore.Stop();
            }
        }

        private void MenuItem_Click(object sender, RoutedEventArgs e)
        {
            MenuItem menuCliccato = (MenuItem)e.OriginalSource;
            switch (menuCliccato.Header.ToString())
            {
                case "Esci":
                    this.Close();
                    break;
            }
        }

        private void RilevamentoScheletroPronto(object sender, SkeletonFrameReadyEventArgs e)
        {
            Skeleton[] scheletri = new Skeleton[0];

            using (SkeletonFrame skeletonFrame = e.OpenSkeletonFrame())
            {
                if (skeletonFrame != null)
                {
                    scheletri = new Skeleton[skeletonFrame.SkeletonArrayLength];
                    skeletonFrame.CopySkeletonDataTo(scheletri);
                }
            }
            if (scheletri.Length != 0)
            {
                /*foreach (Skeleton scheletro in scheletri)
                {*/
                for(int indice=0;indice<scheletri.Length-1;indice++){
                    Skeleton scheletro = scheletri[indice];

                    switch(indice){
                        case 0:
                            if (scheletro.TrackingState == SkeletonTrackingState.Tracked)
                            {
                                ui_StatoScheletroPrimo.Content = "Tracciato";
                                impostaPosizionePunti(ui_PrimoTesta, scheletro.Joints[JointType.Head].Position);
                                impostaPosizionePunti(ui_PrimoCollo, scheletro.Joints[JointType.ShoulderCenter].Position);

                                impostaPosizionePunti(ui_PrimoSpallaSinistra, scheletro.Joints[JointType.ShoulderLeft].Position);
                                impostaPosizionePunti(ui_PrimoSpallaDestra, scheletro.Joints[JointType.ShoulderRight].Position);

                                impostaPosizionePunti(ui_PrimoGomitoSinistro, scheletro.Joints[JointType.ElbowLeft].Position);
                                impostaPosizionePunti(ui_PrimoGomitoDestro, scheletro.Joints[JointType.ElbowRight].Position);

                                impostaPosizionePunti(ui_PrimoPolsoSinistro, scheletro.Joints[JointType.WristLeft].Position);
                                impostaPosizionePunti(ui_PrimoPolsoDestro, scheletro.Joints[JointType.WristRight].Position);

                                impostaPosizionePunti(ui_PrimoDestra, scheletro.Joints[JointType.HandRight].Position);
                                impostaPosizionePunti(ui_PrimoSinistra, scheletro.Joints[JointType.HandLeft].Position);

                                impostaPosizionePunti(ui_PrimoColonna, scheletro.Joints[JointType.Spine].Position);

                                impostaPosizionePunti(ui_PrimoAnca, scheletro.Joints[JointType.HipCenter].Position);
                                impostaPosizionePunti(ui_PrimoAncaSinistra, scheletro.Joints[JointType.HipLeft].Position);
                                impostaPosizionePunti(ui_PrimoAncaDestra, scheletro.Joints[JointType.HipRight].Position);

                                impostaPosizionePunti(ui_PrimoGinocchioSinistro, scheletro.Joints[JointType.KneeLeft].Position);
                                impostaPosizionePunti(ui_PrimoGinocchioDestro, scheletro.Joints[JointType.KneeRight].Position);

                                impostaPosizionePunti(ui_PrimoCavigliaSinistra, scheletro.Joints[JointType.AnkleLeft].Position);
                                impostaPosizionePunti(ui_PrimoCavigliaDestra, scheletro.Joints[JointType.AnkleRight].Position);

                                impostaPosizionePunti(ui_PrimoPiedeSinistro, scheletro.Joints[JointType.FootLeft].Position);
                                impostaPosizionePunti(ui_PrimoPiedeDestro, scheletro.Joints[JointType.FootRight].Position);
                            }
                            else
                            {
                                ui_StatoScheletroPrimo.Content = scheletro.TrackingState;
                            }
                            break;
                        case 1:
                            if (scheletro.TrackingState == SkeletonTrackingState.Tracked)
                            {
                                ui_StatoScheletroSecondo.Content = "Tracciato";
                                impostaPosizionePunti(ui_SecondoTesta, scheletro.Joints[JointType.Head].Position);
                                impostaPosizionePunti(ui_SecondoCollo, scheletro.Joints[JointType.ShoulderCenter].Position);

                                impostaPosizionePunti(ui_SecondoSpallaSinistra, scheletro.Joints[JointType.ShoulderLeft].Position);
                                impostaPosizionePunti(ui_SecondoSpallaDestra, scheletro.Joints[JointType.ShoulderRight].Position);

                                impostaPosizionePunti(ui_SecondoGomitoSinistro, scheletro.Joints[JointType.ElbowLeft].Position);
                                impostaPosizionePunti(ui_SecondoGomitoDestro, scheletro.Joints[JointType.ElbowRight].Position);

                                impostaPosizionePunti(ui_SecondoPolsoSinistro, scheletro.Joints[JointType.WristLeft].Position);
                                impostaPosizionePunti(ui_SecondoPolsoDestro, scheletro.Joints[JointType.WristRight].Position);

                                impostaPosizionePunti(ui_SecondoDestra, scheletro.Joints[JointType.HandRight].Position);
                                impostaPosizionePunti(ui_SecondoSinistra, scheletro.Joints[JointType.HandLeft].Position);

                                impostaPosizionePunti(ui_SecondoColonna, scheletro.Joints[JointType.Spine].Position);

                                impostaPosizionePunti(ui_SecondoAnca, scheletro.Joints[JointType.HipCenter].Position);
                                impostaPosizionePunti(ui_SecondoAncaSinistra, scheletro.Joints[JointType.HipLeft].Position);
                                impostaPosizionePunti(ui_SecondoAncaDestra, scheletro.Joints[JointType.HipRight].Position);

                                impostaPosizionePunti(ui_SecondoGinocchioSinistro, scheletro.Joints[JointType.KneeLeft].Position);
                                impostaPosizionePunti(ui_SecondoGinocchioDestro, scheletro.Joints[JointType.KneeRight].Position);

                                impostaPosizionePunti(ui_SecondoCavigliaSinistra, scheletro.Joints[JointType.AnkleLeft].Position);
                                impostaPosizionePunti(ui_SecondoCavigliaDestra, scheletro.Joints[JointType.AnkleRight].Position);

                                impostaPosizionePunti(ui_SecondoPiedeSinistro, scheletro.Joints[JointType.FootLeft].Position);
                                impostaPosizionePunti(ui_SecondoPiedeDestro, scheletro.Joints[JointType.FootRight].Position);
                            }
                            else
                            {
                                ui_StatoScheletroSecondo.Content = scheletro.TrackingState;
                            }
                            break;
                    }
                }
            }
        }

        private void impostaPosizionePunti(FrameworkElement punto, SkeletonPoint elemento)
        {
            ColorImagePoint puntoprova = sensore.CoordinateMapper.MapSkeletonPointToColorPoint(elemento,ColorImageFormat.RgbResolution640x480Fps30);
            Canvas.SetLeft(punto, puntoprova.X);
            Canvas.SetTop(punto, puntoprova.Y);
        }
    }
}
